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ABSTRACT 


Trunk type robots (TTRs) are exclusive. These robots can provide a high 
level of maneuverability and have a potential in medicine or high risk zones. 
TTRs are determined as a long serial linkage of similar segments. They are 
usually connected using tendons or small actuators. A spherical actuator 
is the most appreciable option. The motion of real spherical actuator (RSA) 


can be easily obtained applying an inverse piezoelectric effect. It has three 

independent spinning axes. These axes are perpendicular to each other 
Keywords: despite the history of excitation. Kinematics and dynamics of RSA almost 
have no basics regardless of mentioned features. This situation can 
be explained according to common disadvantages of other SAs: sophisticated 
structure and complex control. The structures and abilities of TTRs 
are reviewed in the first section of this article. At the beginning of the fourth 
section the kinematics of piezoelectric TTR with two different RSAs 
is introduced. Its results of inverse dynamics using Euler-Lagrange equations 
are presented at the end of the fourth section. Similar results are derived 
using an analytical-potential method in the fifth section. It is quite accurate 
and effective option to determine inverse dynamics of the TTR employing 
an analytical-potential method. 
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1. INTRODUCTION 

A trunk type robot (TTR) is a serial chain of links. They can be connected with tendons or flexible 
and rotary actuators. A real spherical actuator (RSA) has three perpendicular spinning axes and this state 
is constant despite the history of excitation. A spherical actuator usually has very sophisticated structure and 
is hard to control accurately. Consistently a RSA is very unpopular in practical and theoretical cases. 

Grasping abilities of TTR are investigated by Li, Teng, Xiao, Kapadia, Bartow and Walker in 2D 
workspace. The robot is autonomous and consists of flexible pneumatic actuators, but has no end effector and 
closed loop system too. The numerical operations for target detection and path determination take only 0.2 s. 
The time of manipulation ranges from 30 to 130 s seeking to avoid unwelcome oscillations because of low 
stiffness and high inertia [1]. 

A pneumatic robot is introduced by Mahl, Hildebert and Sawodny. It consists of 3 serial stages and 
a three-fingered end effector. Three evenly placed flexible hoses in circumference direction are used 
to control one stage. Every stage can be bended independently. A total bending moment grows up from 
the end point to the first link of the robot, so its cross-sections are enlarged in the same way [2]. 
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Nagarajan, Kumar and Kanna are made a direct kinematic research for a TTR with tendons using 
ADAMS and ANSYS modeling systems. They have selected to explore the robot with four independent 
sections. Every section has 6 serially connected disks and universal joints between them. One tendon is able 
to transfer the force only in one direction. Therefore two tendons are needed to ensure an actuation of single 
DOF. Four evenly posted tendons are used to actuate a single section. Four evenly posted springs has been 
employed for every pair of disks to ensure the stiffness of the robot. The authors have proved again that 
deformations between the disks of the same section are distributed uniformly [3]. 

A special design of soft robot to mimic the motions of elephant trunk or snake slithering 
is generated. The robot is a combination of few sections. Each section is a group of tubular and helical 
segments. They are made from the strips using ionic polymer-metal nanocomposites (IPMCs). This type 
of segments are able to perform not only various actuations (linear expansion, contraction, bending and 
twisting), but energy harvesting and motion sensing too [4]. 

Jones and Walker have presented a kinematic theory for a TTR with flexible links. It can be actuated 
employing different air pressures in gofferred hoses or different lengths of tendons too. The estimation 
of position and orientation and a brief report about its singularities are described comprehensively. The local 
parameters of pressures or lengths and their first or second derivatives can be estimated according to inverse 
Jacobian matrix [5]. 

Chung, Rhee, Shim, Lee and Park have analyzed door opening robots. These robots can be used 
in emergency situations to shift humans. These authors have offered a new conception for that kind of robots. 
They suggest a manipulator with three fingers and the force sensors at their tips as an alternative for a wrist 
sensor. It has a high price and a complex structure too. A tested robot can be separated into 3 motion stages: 
omnidirectional chassis, manipulator with 6 degrees of freedom (DOFs) and an end effector with 3 fingers. 
These stages are actuated by 14 servomotors. 16 sonar, 16 infrared sensors and a laser range finder 
are installed to enhance the features of robot vision [6]. 

A TTR of serially connected tubes with inclined end planes at one side is presented by Salomon and 
Wolf. It is able to perform 16 degrees of freedom. The same type planes of the tubes are conjugated together. 
A revolute actuator goes after cylindrical-incline actuator and so on. This robot provides high level features 
like stiffness and position accuracy. It possesses these dimensions: diameter of tube is 7.7 cm, 
total length-80 cm and a maximum deviation anglel80°. A maximum traverse force at the end 
of the robot should be less than 25% of its own weight [7]. 

The abilities of motion are investigated and tested by Liljebaick, Haugstuen and Pettersen for a snake 
type robot (STR). This robot is composed of 10 spherical segments. They are serially connected with short 
flexible links. A STR has a similar structure according to a TTR. The rotating frame with crosswise oriented 
wheels around it is attached to every segment. This way the action of moving straight and transversely 
is ensured for every segment. A proper control of the robot is achieved using an internal function ode45 
in MATLAB software. A combined task of STR is to detect a straight cursor line, change its direction and 
crawl along the line. The task has been successfully implemented using a novel stabilization algorithm [8]. 

Kelasidi, Jesmani, Pettersen and Gravdahl have introduced a multi-objective optimization 
framework. This method is applied to investigate the efficiency of locomotion for snake type robots 
employing a weighted sum method. A Particle Swarm Optimization (PSO) is used for different set of weight 
factors. The consumed power of the robot and its forward velocity are selected as the main parameters 
of research. Consistently an improved energy efficiency of locomotion associates with the decrement 
of forward velocity [9]. 

Important processes of redundant robots like motion, recognition of objects, fetching and safe 
interface with humans have been widely investigated by Luo and Kuo. A service-oriented multiagent system 
(SoMAS) is used to control and analyze the robot with cyber-physical system (CPS). The results 
of mentioned operations approve the effectiveness of integrated systems regarding to high position accuracy 
and fast speed. Other high quality factors of the robot in comparison to the results of other researchers are 
mentioned too [10]. 

Several piezoeletric robots are presented in Figures 1 and 2. They can be named as trunk type robots 
and have been made in Mechatronics Institute of KTU. Piezoelectric TTRs are special because of small 
dimensions (total length usually is less than 20 cm) and high ratio of output power to mass. They possess 
a simple structure and a high accuracy of position too. These TTRs can be significant in medicine or high risk 
zones. An extra freedom to manoeuvre is achieved employing a piezoelectric spherical actuator with 
3 independent spinning DOFs. A piezoelectric tube Figure 3 and a hollow ball are the main structural parts 
of the actuator. 

The ball is a passive link of aluminium, steel or other material with high Young modulus. 
Several layers of distinct materials are a possible structural option of passive ball too. Single piezoelectric 
tube has to be modified in order to provide three permanent spinning axes. Therefore an internal electrode 
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of the tube is separated into three equal sections. Driving teeth are employed to define accurate contact zones 
with the ball. Control techniques for multi-axis piezoelectric actuators are already defined [11]. 

The aim of this work is to determine inverse dynamics of TTR with two different spherical 
actuators. This robot has a maximum number of DOFs for 3D manipulation. The determination of robot 
dynamics also includes the estimation of Coriolis and centrifugal forces. These forces are hard to evaluate 
in analytical way. According to that is selected to use a universal and effective method of Euler-Lagrange 
equations and an analytic-potential model too. The results of preferred methods are almost equal, but their 
operational speeds are different. 


3 driving teeth 





Figure 1. Piezorobot with 6 DOFs Figure 2. Piezorobot with 15 DOFs Figure 3. Structure of 
modified piezoelectric tube 


2. REVIEW OF EULER-LAGRANGE DYNAMICS 

Euler-Lagrange (E-L) method is one of the most universal and simplest ways to solve inverse 
dynamics of mechanical system. It lets use different coordinate systems (CSs) and consists of the highest 
integral members. Those are potential P; and kinetic T; energies of the links. E-L method is based 
on differential approach. Therefore it can provide all possible action and reaction forces or torques. It leads 
to a final form (1) [12]. 


f =D(q)-¢+C(a,q):¢4+9(@) (1) 


where: f — vector of total torques for actuation of the DOFs; q,q — vectors of local robot coordinates and 
their first derivatives respectively; D(q)G—matrix of torques to evaluate inertial properties; C(q, q.)q—matrix 
of torques to estimate the effects of friction, damping and the influence of centrifugal and Coriolis forces 
also; g(g) — matrix of torques to evaluate the effect of gravity and so on. 

E-L method can be employed to determine the dynamics of systems with flexible links [13] 
and to implement various restrictions for its investigation too [14]. This method is selected to evaluate 
the torques of robot DOFs at picked time moments. The dependencies of the torques on time can 
be approximated too. 

General Euler-Lagrange equation is presented in (2). Consistently a special variable La called 
Lagrangian is needed to estimate (3) [15]. A new and more comprehensive formula of E-L (4) can be written 
using the special features of Lagrangian. Kinetic energy of spinning link 7 is evaluated by (5) and potential 
energy of the same link is determined by (6). 


d ðLa oOLa 
aa (2) 
dt ðq ôq 


La= ) Ti- 9P. (3) 
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B d oT OP (4) 
i. dtdq ðq 
T; = Trace(a,a; )l;/2 (5) 
P; = —m,gh; (6) 


where: — a single derivation on time and a partial derivation on local coordinate respectively; 


d ð 
at’ ðq 
La—substitute of mechanical energy for investigated system (Lagrangian); t — time; T; P; — kinetic and 
potential energies of link 7 respectively; Trace()—-sum of elements on the main diagonal of matrix; w;—matrix 
of angular speed projections to the base CS regarding to link i; I;, m;, hi — moment of inertia, mass and center 
height of the link in accordance to the grounded CS; g — acceleration of gravity and so on. 

The speed of any robot point can be estimated employing (7). The derivative of single orientation 
matrix can be determined using (8). 





ee a E. Al. A? A! 
Yo = FM Eo O° ET a ari | (7) 
= AAi ...* Aian FAAI «+ Aian +: Aor 
d. OAL, . 
D aeg Q 
dt 1! 00a, ` 


where: vi—global speed vector of selected link-point i; ri, r;-global and initial position vectors of 
the link-point respectively; O}—global orientation matrix of the link, which directly associates with point i; 

i -single orientation matrix from the first CS to the grounded CS; 6,—-local coordinate (angle) 
of link i and so on. 


3. PARAMETERS OF DYNAMICAL TASK 

A TTR with two different spherical actuators Figure 4 is selected to explore. A preferred spherical 
actuator consists of a modified piezoelectric tube with three evenly distributed internal electrodes 
in circumferential direction and a spherical segment. Three longitudinal zones of the tube can be excited 
independently, but generated displacements are partially dependent because of a monolith structure. 

The kinematical lengths of the first (OO,) and second (O,O2) robot links are chosen to be equal 
to 40 mm. The first link of the TTR is compounded of piezoelectric tube and two cut balls. External radiuses 
of the balls from steel are equal to 10 mm and their internal radiuses-9 mm. An external diameter 
of the tube is 10 mm, its internal diameter and length are 8 and 24 mm respectively. The second link 
of the TTR is made of piezoelectric tube too. Its length is 31 mm and it has the same cross-section 
dimensions. The tubes are made of PZT-4, which density is taken as 7.6 g/cm’. The density of steel 
is selected as 7.8 g/cm’? . Therefore the masses of the first and second links are 21.7 g (9) and 
6.7 g (10) respectively. 


4 3 3 mD? m(D? a, d*)l, 
m=2 3 A(R = i) Pst + ——q____ Par (9) 


2 2 

me — bz (10) 
4 

where: m4, mz—masses of the first and second links respectively; 7—Archimedes’ constant; R, r-external and 

internal radiuses of the ball; D, d — external and internal diameters of piezoelectric tube; psn ppz7-densities of 

steel and PZT-4 respectively; l,, l2, —lengths of the first and second piezoelectric tubes respectively. 

A reference point of the grounded robot coordinate system (CS) is marked as O. A reference point 
of the first link CS is noted as O, and the point of the second link CS — as O}. An axis Zp is parallel to the axis 
of gravity, an axis z,—to a longitudinal symmetry axis of the first link and an axis z2-to the symmetry axis 
of the second link. The first and second coordinate systems of the robot are rigidly attached to the first and 
second links respectively. A reference configuration of the robot can be notified as initial, when the same 
type axes are made parallel to each other (X9-X1-X2, Yo-yi-y2 and Zo-Z\-Z2). The tube of the first spherical 
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actuator is its primary link with direct control to its secondary link. The tube of the second spherical actuator 
is its secondary link with indirect motion. It provides two actions at once: excitation and movement. 
The orientations of tube axes are permanent, because its geometry is static. Therefore the first spherical 
actuator can be referenced as direct type and the second spherical actuator-as inverse type [16] with rotational 
axes X2-y2-Z2 placed on O; reference point. This repetition of O, coordinate system is important to ensure 
the rightness of actuating. Consistently evaluation methods of orientations for movable links are going 
to be different. 





Figure 4. TTR with two different spherical actuators 


Seeking to properly determine an orientation matrix of the selected link is important to evaluate 
its actuation sequence. To realize a hybrid rotational axis and to ensure a proportional excitation of selected 
DOFs is a very complicated technical task, because of finite stiffness of the ball, friction dependency 
on speed, losing contact pair or the action of external torque and so on. The manipulation of real spherical 
actuator can be executed more accurately only if its DOFs are going to be activated separately. 
This statement can be proved regarding to a simpler control technique, which requires a lower knowledge 
of experimental testing. To implement casual orientations for robot links are picked to spin the first link 
about xo and yo axes by angles 0.12 and 0.15 rad respectively and to spin the second link about x» and y, axes 
by angles -0.1 and -0.15 rad respectively. To realize a next robot configuration is selected to activate only 
x type of axes. Every angular speed dependence of x type axes on time is chosen to be a triangle type 
Figure 5. Amplitudes of global angular speeds for axes Xọ and x, are selected to be 0.1 and -0.05 rad/s 
respectively. Both DOFs are going to be started at the same time and their durations are 2 s. The maximum 
sizes of local angular speeds for movable links are equal to their magnitudes of permanent accelerations 
(0.1 and -0.15 rad/s” respectively). The last parameters can be easily estimated and are important for 
estimation of kinetic torques in robot dynamics employing an analytical way. 

A center of link mass is taken as a middle point of its longitudinal symmetry line, because each 
robot link is a rod type. A mass moment of inertia in accordance to parallel axes of body is presented 
in (11). The first link moment of inertia about x; or y; axes can be evaluated by (12) and is 16.6-10° kg- m’. 
Its moment of inertia about z; axis is determined by (13) and is equal to 1.4-10° kg-m’. The second link 
moment of inertia about x, or y axes can be estimated with (14) and is 4.6- 10° kg-m’. Its moment of inertia 
about z; axis is determined by (15) and is equal to 0.6-10° kg: m”. 


bya = leg + md? (11) 
2(R° — r”) 
lig = hy = mı ¿l? /12 + m di T 2Msp 5(R3 r?) T Moy L4 (12) 
2(R° — r°) 
lz = m (D? + d*)/2 T 2Msp sR =r") (13) 
In x = In y = ml2/12 T md? (14) 
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where: Ie a Ip a — mass moments of inertia in accordance to center axis and parallel moved axis of body 
respectively; m — body mass; d — normal distance between the axes of inertia; l x, I2 x - mass moments of 
inertia about x axes of the first and second links respectively; m,,— mass of the first link tube (5.2 g); 
d,—distance between inertial axes of the first link (20 mm); m,,—mass of the hollow ball (8.3 g); 
L,—kinematical length of the first link (40 mm); d,—distance between inertial axes of the second link (24.5 
mm) and so on. 

The first link of the TTR is able to turn only about the axes of coordinate system O. This means that 
any spinning axis of the CS is going to be a hybrid one in accordance to principal axes of the first link. 
An analytic-geometric approach can be selected to evaluate a mass moment of inertia for free chosen 
axis (MIFCA). 

A freely selected axis OL of inertia has to cross a mass center of body K and be expressed by three 
spatial angles a, 6, y in accordance to its principal axes x, y and z Figure 6. A general formula of the MIFCA 
is introduced in (16). Centrifugal moments Jz, /,, and Zy of the body are equal to 0, because it is fully 
symmetric and isotropic. Now it is important to mention an orientation matrix (17) of body K according 
to the base CS. Then mass moments of inertia for the body can be apparently determined regarding 
to the main CS axes (18-20). If the moment of robot link is estimated in accordance to earlier spherical joint, 
then it is important to evaluate the additional inertial quantity of shifted axes. 


W(rad/s) 





Wmax 





0 3 2 ts) 


Figure 5. Shape of angular speed dependence Figure 6. Mass moment of inertia for free 
on time selected axis 


Io, = (cos a)*1, + (cos p)’ L, + (cos y)?l, — 2 cos B cos ylyz — 2 cos y cos aly, 





— 2 cos q cos fP lyy (16) 
Xxo Yxo Zxo 
o% = Xyo Yyo a (17) 
Xz Yzo 420 
Ik xo = (Xx) lx + (Yoo) ly + (Zx) Iz (18) 
Ik yo = Can h + On) ly + Cae (19) 
Ik zo = (xz) Ix + (Ye) ly + Cee (20) 


where: lọ, mass moment of inertia for body K regarding to a selected axis OL; a — angle between 
a spinning axis OL and a principal axis x of the body; /,, I, I, — principal moments of inertia for body K; x,,,, 
Yxo> Zx projections of principal axes (x, y and z) to a base axis Xo; [x x,, Ik_yọ IK zọ mass moments 
of inertia for the body according to the main CS axes (Xo-Yo-Z) and so on. 


4. APPLICATION OF EULER-LAGRANGE DYNAMICS 

An initial orientation of the first link is estimated by (21) using Roll-Pitch-Yaw method and 
the orientation of the second link-by (22) [17]. The last equation can be proved employing orthogonal and 
transposition features of matrices. An orientation of the first link at the first and second halves of actuation 
can be evaluated by (23 and 25) respectively. An orientation of the second link at the first and second halves 
of actuation can be determined by (24 and 26) respectively. In order to estimate a TTR control function 
of any DOF is selected to use three main time points (initial, medium and final) of its excitation period. 
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Local speed dependencies on time of the first link can be determined employing these forms: 
W1,(0 < At < 1) = &ifpôt, w,,(1 < At < 2) = Qiy — E&isyAt, wx (At = 2) = 0. The speed dependencies 
of the second link can be written using the same way. Global speeds of the first and second halves regarding 
to the first link are estimated by (27-28). The speeds of the first and second halves according 
to the second link are evaluated by (29-30). 


01 = A, Ay (21) 
02 =(A,-A,) =AL- AT (22) 
Og(t < 1s) = Ax(E1x ` t?°/2) - Ay (01y) Ax (rx) (23) 


05 (t<1s)= A, (1x ` t*/2) i Ay (01y) ' Ax (Oix) i A% (02x) f AT (02%) ` Az (Ezx ` t? /2) (24) 
O3(t > 1s) = A,(0.05 + 0.1 — ey ` (t — 1)? /2) - Ay (Ory) - Ax (01x) (25) 


oĉ (t > 1s) = A, (0.05 + 0.1 - t — €,,-(t — 1)? /2) Ay (61) - Ax (01) < AZ (027) 

















26 
- AT (02y) - AZ(—0.075 — 0.15 - t — £z% - (t — 1)? /2) oo 
a02 
W1FH = Ta ft” -2 (€&ixt) (27) 
x 
ðot 
ws = eal C =D (One ee) (28) 
x 
0o02 00? 
W2FH = TE : 2 $ (€,,t) + ae $ 2 £ (€5,t) (29) 
007 
W25sH = —/-(t —1)*-2. (Qix aor = 1)) 
Eix 
002 (30) 
+ 9 /-(-1)* -2- (D5 =o = 1)) 
Elx 


where: A,.-single orientation matrix about axis x; A{-transpose matrix of A,; OŽ-orientation matrix from 
the second CS to the first CS; €,,, €2,-variables of angular accelerations about x axes for the first and second 
links respectively; 01x, @;,-selected angular movements of the first link about xp and yo axes (0.12 and 
0.15 rad respectively); Wiry, @1sq-angular speeds of the first link at the first and second halves respectively; 
Qix», Q2,-amplitudes of global angular speeds about axes Xo, (replaced) x, respectively and so on. 

A total kinetic energy of the system is estimated employing (31). Kinetic energy of the second link 
is determined by (31) and kinetic energy of the first link-by (33). A mass moment of inertia for 
the first link about axis Xo is evaluated by (34) and the moment of the second link about xo-by (35). 


fat ar (31) 
T> = Trace (wzy ` @5y) ` (Iz x,/2)/2 (32) 
T, = Trace (wy ` wx) - (l x,/2 + I x,/2)/2 (33) 
h x = (AD) + ty, + (08(1.2))° -h y, + (0.3) -h z (34) 
ba =A ye, EEI) ut OD) ae. cc 


+ m ((09 (3.3) : L1)” + (09 (2.3) + L1)*) 


Where: 77, T2 — kinetic energies of the first and second links respectively; J; xos I2 xo-mass moments 
of inertia of the first and second links respectively in accordance to Xp axis and so on. 

The total potential energy of the robot is estimated with (36). The potential energies of the first and 
second links are determined by (37-38) respectively. 
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P, = —m,g(05 (3.3) -L,/2) (37) 
P, = —m2g(05 (3.3) - Ly + 05 (3.3) - L2/2) (38) 


where: P, P>-potential energies of the first and second links respectively; L»,-kinematical length 
of the second link (40 mm) and so on. 

Dynamical results are estimated and presented in Table 1 and Figure 7 in regard to Euler-Lagrange 
method and selected parameters of motion. 


Table 1. Dynamical results of the TTR 


Time moment (s) Quantity M1 (Nm) M2 (Nm) 

Total 11,12-107 -2,844-107 

0 Potential 11,08-107 -2,837-10* 

Kinetic 3,781-10° -6,697-107 

0,33 Potential 11,62-10* -3,006- 107 

0,67 Potential 13,30- 104 -3,532-107 

Total 15,89-107 -4,350-107 

1,00 Potential 16,00: 10 -4,370- 107 

Kinetic -11,34-10° 2,009-10° 

1,33 Potential 18,67: 107 -5,188-107 

1,67 Potential 20,30: 10* -5,680- 107 

Total 20,82:107 -5,836°107 

2,00 Potential 20,82: 10% -5 836-107 
Kinetic 0 0 


Total torques of spherical actuators 





> 12 == 

< 

| 9 

= 6 

p == M2 

a3 3 ime (Ss 

A 0 

-3 Pea 2 25 
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where: M1, M2-total torques about x axes of the first and second 
spherical actuators respectively 


Figure 7. Dependencies of total torque on time 


5. DYNAMICS OF ANALYTICAL-POTENTIAL METHOD 

Analytical-potential method has been selected to assure the correctness of described E-L algorithm 
and its results. The orientations of robot links at the initial, medium and final configurations are determined 
by (23-26) too. The control of the first link is based on the main coordinate system O. Its zo axis 
is coincident with a gravitational axis. Therefore an evaluation of potential torque for the first SPA is quite 
simple (39). A value of torque about x axis is rated as positive, when the direction of links y projection goes 
from y axis to z axis (upward in the main quarter of y—z plane or downward in -y—z plane). Every single 
magnitude of potential torque should be multiplied by -1 in order to realize an opposite direction 
of gravitational force or the sense (negative to positive) of its elbow. 

M; x = —(mgg0$(2.3) - L,/2 + mzg(O§ (2.3) - Ly + 06 (2.3) - L2/2)) (39) 
where: M, ,—torque about Xo axis because of gravity. 

To evaluate a potential torque of the second link firstly the orientation of spinning axis x, to the global 
area Xo-Yo has to be determined. This can be done employing arctangent function (40-42), which depends 
on projections senses of mentioned axes Figure 8. Then an apparent torque (43) of the link and 
its orientation (44-46) to global area xo-yo have to be estimated. Finally a perpendicularity of apparent torque 
to axis Xx) can be evaluated and a perpendicularity of the same axis to a gravitational axis Zo too. 
The last two steps are essential in the estimation of the torque about a replaced axis x> (47). 
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Sıı = arctg(0§(1.1)/0§(2.1)), if 0 (1.1) > 0 and 0§(2.1) > 0 (40) 
Sı2 =m + arctg(0§(1.1)/0§ (2.1)), (41) 
if 02(1.1) > 0 and 02(2.1) < 0 or 02(1.1), 02(2.1) < 0 
S13 = 2m + arctg(O02(1.1)/02(2.1)), if 02(1.1) < 0 and 02(2.1) > 0 (42) 

2 2 2 2) 1/2 
Nz x = Mg (((03(1.3)) + (08(2.3)) ) -L /2) (43) 
S3; = arctg (02(1.3)/02(2.3)), if 02(1.3) > 0 and 02(2.3) > 0 (44) 
Soo = T + arctg (0 (1.3)/0§ (2.3)), (45) 
if 02(1.3) > 0 and 02(2.3) < 0 or 02 (1.3), 02(2.3) < 0 
Sy 3 = 2m + arctg(02(1.3)/03(2.3)), if 02(1.3) < 0 and 02(2.3) > 0 (46) 
, 2 2 4 (Q2 2) ui? 47 
Mz x = —Nz x + Sin(S,; — Sj) - ((03(4.1))° + (08(2.1))*) (47) 


where: S; ;—arctangent function to estimate the direction (i-mark for sense of orientation and j-index for applicable 
function); N2 „ M2 „— apparent and real torques about a replaced axis x, because of gravity and so on. 

Numerical and graphical results are generated Table 2, Figure 9 in accordance to a recently 
described method of inverse dynamics. It is based on the action of gravity regarding to the adequate 
parameters of motion. 


Table 2. Results of the analytic-potential research 








Time moment (s) M1*(Nm) M2*(Nm) 
0 11,08- 107 -2,837-107 
0,33 11,62-10% -3,006- 107 
0,67 13,30- 10% -3,532-10° 
1,00 16,00: 104 -4,370-107 
1,33 18,67: 10% -5,188-107 
1,67 20,30: 10* -5,680- 107 
2,00 20,82: 10% -5,836- 107 
24 
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tg nt 
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and second spherical actuators respectively 


Figure 9. Dependencies of potential torque on time 


6. CONCLUSION 

The results of Euler-Lagrange dynamics are partly confirmed by the results of analytic-potential 
method. Kinetic torques of E-L method can be confirmed by theoretical way too. Actuators dependencies 
of total torque on large time steps can be approximated as linear graphs. Actuators dependencies of potential 
torque on smaller time steps are similar shapes to links dependencies of position. Kinetic torques are more 
than 100 times smaller than potential ones regarding to adequate input parameters. The calculation with 
MATLAB software of 14 potential torques according to E-L method lasts about 2.8 s and an analogous 
evaluation regarding to analytic-potential method takes about 3.1 s. The estimation with the same software 
of 6 potential and 6 kinetic torques in regard to Euler-Lagrange method lasts about 5.3 s. A casual E-L 
method can be simplified or changed into the analytical-potential method seeking to improve coding speed 
and to accelerate numerical operations of dynamical analysis for a gently trunk type robot. 
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